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(54) Direction finder 

(57) A direction finder includes a terrestrial magnetism sensor (2), a magnetization correction means (3, 4) 
for correcting the output (x, y) of the sensor (2) with a magnetic field component produced by the vehicle 
on which the sensor Is mounted and a correction amending means (6) for amending a corrected output, 
the correction amending means (6) determining the co-ordinates (Xp, y p ) of a crossing point between a line 
extending perpendicularly from co-ordinates (x v1 , y v1 ) corresponding to a correction produced by the . 
magnetization correction means (3, 4) onto the perpendicular bisector (I) of a line connecting two co- 
ordinate points (x n , y n ; x„ y,) obtained by the sensor (2) at different times with the vehicle having different 
orientations. 
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The drawing(s) originally filed was/were informal and the print here reproduced Is taken from a later filed formal copy. 
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SPECIFICATION 
Direction finder 

5 The present invention relates to a direction finder for use in a navigation system of a vehicle, 5 
which is capable of finding a moving direction of the vehicle on the basis of terrestrial magne- 
tism. 

There have been many navigation systems of this type and some will be described in detail 
subsequently with reference to the drawings. Such direction finders need correction to compen- 

10 sate for the magnetic influence of the vehicle on which the direction finder is mounted. At 10 
present none of the conventional direction finders make any allowance for the magnetic influence 
of the vehicle changing during operation. 

According to this invention, a direction finder comprises a terrestrial magnetism sensor 
mounted on the vehicle for detecting a pair of orthogonal components of a horizontal component 

15 of terrestrial magnetism to provide a pair of detection signals corresponding to the orthogonal 15 
components, respectively; a magnetization correction means for correcting the pair of detection 
signals with a pair of correction values necessary to cancel out the influence of a magnetic field 
produced by the vehicle and providing a pair of corrected detection signals; and a correction 
amending means for obtaining the perpendicular bisector of a line connecting two co-ordinate 

20 points corresponding to the pair of detection signals from the terrestrial magnetism sensor and 20 
the pair of corrected detection signals from the magnetization correction means on a rectangular 
co-ordinate system and to amend the correction values on the basis of the co-ordinate compo- 
nents of a crossing point of the perpendicular bisector and a line extending perpendicularly from 
the perpendicular bisector to that crossing point. 

25 A particular example of a direction finder in accordance with this invention, will now be 25 
described and contrasted with the prior art, with reference to the accompanying drawings, In 
which: 

Figures 1 and 2 illustrate the operating principle of a direction finder with the assumption of 
the vehicle generating no magnetic field; 
30 Figures 3 and 4 illustrate the operating principle of a conventional direction finder when the 30 
vehicle does generate its own magnetic field; 
Figure 5 is a graph illustrating a variation of magnetic field with time; 
Figure 6 is a block diagram of an example of the present invention; 
Figure 7 is a graph illustrating the principle of operation of the present invention; 
35 Figure 8 shows a block diagram of the example shown in Figure 6 in more detail; 35 
Figures 9a and 9b are flow charts illustrating the operation of a micro-computer shown in 
Figure 8; and 

Figure 10 is a flow chart showing an alternative operating strategy of the micro-computer. 
In a typical conventional direction finder the horizontal component H of terrestrial magnetism, 

40 which is referred to as "terrestrial magnetism H" hereinafter, is detected by a terrestrial magne- 40 
tism sensor 2 mounted on a vehicle 1, e.g. an automobile, whose heading makes an angle 6 
with respect to the direction of terrestrial magnetism H, i.e. north. That is, the sensor 2 detects 
a field component Hy (=H cos 0) of the magnetism H which is in parallel with the moving 
direction A of the vehicle 1 and a field component Hx (=H sin 0) orthogonal to the direction A 

45 and provides electric signals x and y in the form of, for example, voltages corresponding 45 
thereto. The electric signals x and y are amplified suitably. Thus, the electric signals x and y can 
be expressed by 

x ■ K Hx e K H sin 9 (la) 

50 50 
y = R Hy = K H cos 0 (lb) 

where K is a magnetism/voltage conversion co-efficient. 
55 The detected signals x and y when the field components Hx and Hy are zero are calibrated to 55 
zero so that the magnitudes of the signals x and y are in proportion to the intensities of the 
components Hx and Hy, respectively and can be used as reference values. 

Fig. 2 shows an x-y rectangular coordinates system on which points each defined by magni- 
tudes of the electric signals x and y are plotted. A locus of the plot describes a circle 0, and 
60 the angle 6, i.e., the orientation 6 of the vehicle 1 is given by 60 

9 = tan'^x/y) (2) 

65 Although the direction of the terrestrial magnetism H is not coincident with the geographical 65 
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north and there is an error, i.e., declination therebetween. The deciination depends on areas of 
the earth. It is assumed in this description, however, that there is no declination for simplicity of 
explanation. 

It has been known that, due to magnetization of magnetic material of various components 
5 constituting the vehicle, the orientation 6 calculated according to the equation (2) is not always 5 
correct. 

Describing this in more detail with respect to Figs. 3 and 4, the vehicle 1 is subjected to a 
magnetic field Hv shown in Fig. 3 produced by those magnetized components. With the mag- 
netic field Hv, the magnetic field to be detected by the terrestrial magnetism sensor 2 becomes 
10 a composite magnetic field He of the terrestrial magnetism H and the magnetic field Hv. 10 
Coordinates (x,y), (x^Vy) and (x e ,yj of signals from the sensor 2, corresponding to coordinates 
(Hx,Hy), (Hvx,Hvy) and (Hex,Hey), are shown in Fig. 4. Thus, the signals xe and ye from the 
sensor 2 are represented by 

15 x e = x + x v = KH sin 9 + x y (3a) 15 

Y e = y + y v = KH cos G + y v (3b) 



20 where the angle 8 Q obtained from the signals x e and y e according to the equation (2) becomes 20 
0 e = tan~ 1 (x e /y e ) (4) 

25 Thus, a true orientation 6 can not be obtained. 25 
However, since the field Hv is produced by the vehicle 1 as a permanent magnet and an 
intensity and direction thereof with respect to the moving direction A of the vehicle 1 are 
constant, the coordinates (x^y;,) of the signal corresponding to the magnetic field Hv shown in 
Fig. 4 is kept unchanged even if the direction A is changed. Therefore, a locus of the coord i- 

30 nates (x^yj of the detection signal when the vehicle 1 runs once along a circle becomes a circle 30 
0 2 having a center point (x v ,y v ) as is clear from the equations (3a) and (3b). Therefore, by 
obtaining the center coordinates (x^yj of the circle 0 2 from the detection signals x, and y c , the 
true orientation 6 can be obtained easily from the following equation 

35 0 = tan" 1 ((x e - x v )/(y e - y v )) (5) 35 

Japanese Patent Application Laid-Open No. 148210/1982 discloses a technique by which the 
true orientation 6 is obtained by cancelling out influences of the magnetic field Hv on the basis 

40 of the principle mentioned above. In detail, among the detection signals x and y obtained from- 40 
the terrestrial magnetism sensor 2 when the vehicle 1 circles once, maximum values x max and 
y™, and minimum values x^ and y,™ in the respective axes of the x-y rectangular coordinates 
system are stored and the detection signals x v and y v corresponding to the magnetic field Hv is 
obtained as coordinates of the center of the circular locus 0 2 , according to the following 

45 equations 45 

X v = (X m*v + X m in>^ ( 6a > 

v max mm 

y = (y + y . )/2 (6b) 

50 v ljr max ^min" v ' 50 

Therefore, by turning around the vehicle 1 in a suitable time to obtain the detection signals ^ 
and y v corresponding to the magnetic field Hv, it is possible to obtain the true orientation 6 by 
performing an operation of the equation (5). 
55 However, when the vehicle 1 is, for example, an automobile, it is subjected to vibrations 55 
during its movement. Therefore, the magnetic field Hv may vary gradually as shown in Fig. 5, 
although the variation might be negligible when averaged over, for example, one day. In addition, 
when the automobile crosses a d.c. powered railway line at a time instance v it may be 
magnetized by a magnetic field produced by a d.c. current flowing through the rails and cables 
60 and thus the intensity and direction of the field Hv are considerably changed. With such change 60 
of the field Hv, the automobile must circle again to obtain the signals x„ and y v corresponding to 
the changed field Hv. This is very difficult practically. 
An example of the present invention will be described with reference to Figs. 6 to 9a. 
In Fig. 6, the navigation system includes a terrestrial magnetism sensor 2 which is identical to 
65 that shown in Fig. 1 , a magnetization correction means 3 for correcting detection signals x and 65 
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y obtained by the terrestrial magnetism sensor 2 on the basis of a pair of correction amounts ^ 
and y 0 by which an influence of a magnetic field Hv is cancelled out, according to the following 
equations 

5 x. = x - X^ (7a) 5 

n o 

y h = y - y c (7b) 

10 and providing a pair of corrected detection signals x h and y h , an initial correction means 4 10 
which is actuated by operation of a switch 5 to detect and store the detection signals x and y 
upon a turning operation of a moving body 1, to obtain detection signals Xy and y„ correspond- 
ing to the magnetic field Hv according to the equations (6a) and (6b) and to set the values x„ 
and y v to the correction values x 0 and y„ for a subsequent use in the magnetization correction 

15 means 3, a correction amending means 6 responsive to the detection signals x and y from the 15 
sensor 2 for amending the corrected values x 0 and y D such that the values approach coordinates 
(Xy, y v ) on an x-y rectangular coordinate system corresponding to changed magnetic field Hv, an 
angle calculation means 7 responsive to the correction detection signals x h and y h from the 
magnetization correction means 3 to operate an orientation 0h according to 

20 20 

9 « tan" 1 (x h /y h ) (8) 

and a display means 8 for displaying the orientation 6h from the angle calculation means 7. 
25 The components depicted by reference numerals 3, 4, 6 and 7 constitute a control means 9. 25 
A principle of operation of the correction amending means 6 will be described with reference 
to Fig. 7. In Fig. 7, it is assumed that coordinates on the x-y rectangular co-ordinate system of 
the magnetic field Hv are represented by (Xv„y v1 )and (x^y^), respectively, coordinates corre- 
sponding to the detection signal pair obtained after the magnetic field Hv1 varies to Hv2 are 
30 represented by (x„y t ) and (vy,), respectively, and values set in the correction values *<, and y 0 / 30 
of the magnetization correction means 3 before the field Hv changes are represented by x v , and 
y v2 , respectively. 

The perpendicular bisector % of the line connecting between the coordinates (x„y,) and (x n ,y n ) 
corresponding to the detection signals obtained after the field HvT is changed to Hv2 passes, 
35 necessarily, through the coordinates (x v2 ,y v2 ) corresponding to the field Hv2 and representing a 35 
coordinates of a cross point of the line £ and a perpendicular line extending from the coordinates 
(x v1 ,y vt ) corresponding to the field Hv1 to the line £ by (x p ,y p ), the following equation (9) is 
established between the coordinates (x v1 ,y v1 ), (x^, y v2 ) and (x^Vp) 




40 



Therefore, the coordinates (x^yp) of the cross point becomes equal to or at least closer to the 
45 coordinates corresponding to the field Hv2 than the coordinates (x 0 ,y 0 ) corresponding to the 45 
correction amount before- the magnetic field Hv is Hv1, i.e., the coordinates (x v1 ,y vl ), thus, after 
the magnetic field is changed, the components x p and y p of the coordinates (VYp) °f the cross- 
point are set as the correction amounts x 0 and y 0 . By repeating this operation, it is possible to 
proximate the correction amounts x 0 and y 0 to the components x^ and y v2 corresponding to the 
50 magnetic field Hv2, i.e., the correction amounts necessary to cancel out the influence of the 50 
magnetic field Hv2. 

Fig. 8 shows the embodiment in Fig. 6 in more detail in which same components are depicted 
by same reference numerals, respectively. In Fig. 8, the control means 9 comprises an A/D 
converter 10 for converting the detection signals x and y from the terrestrial magnetism sensor 

55 2 into digital values, a microcomputer 11 composed of an input circuit 11a, a memory 11b, a 55 
central processing unit (CPU) 11c and an output circuit 1 1d and a display driver 12 responsive 
to an output of the computer 1 1 for driving the display 8. The display 8 which may include a 
liquid crystal display panel has display segments 8a to 8h which are driven by an output of the 
driver 12 to illuminate one at a time for displaying the orientation 6h. 

60 An operation of the computer 1 1 will be described with reference to the flow-charts shown in 60 
Figs. 9a and 9b. 

In Fig. 9a, when a power source (not shown) is connected by operating the switch 5, the 
terrestrial magnetism sensor 2, the control circuit 9 and the display 8 begin to operate. That is, 
the sensor 2 starts to detect terrestrial magnetism H and provides detection signals x and y 
65 corresponding to the x and y components thereof which are A/D converted by the A/D 65 
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converter 10 and then the digitized signals are supplied to the computer 11. 

The computer 11 performs a main routine starting from the step 101, as shown in Fig. 9a. In 
the step 101 , it is determined whether or not the switch 5 is turned on. If yes, the initial 
correction routine is performed in the step 102 to obtain the correction amounts x,, and y 0 . 
5 An operation of the magnetization correction means 3 is shown in the steps 103 and 104. 5 
That is, the detection signals x and y are inputted in the step 103 and then the correction 
detection signals x„ and y h are obtained according to the equations 7a and 7b in the step 104. 

Then, the orientation 0h is obtained according to the equation (8) in the step 105 and the 
signal 0h is provided to the display driver 12 in the step 106. The steps 105 and 106 
10 correspond to an operation of the angle calculation means 7. The display driver 12 drives the 10 
display 8 to cause it to display the orientation 0h by illuminating a suitable one of the display 
segments 8a to 8h thereof. 

Thereafter, within a predetermined period T, the routine is returned to the step 101 and the 
same operation is repeated until the time period T lapses. 
15 When the time period T lapses while the operation of the magnetization correction means 3 is 15 
repeated through the steps 101 to 107, a correction amending routine is performed in the step 
108, which is shown by the flow-chart in Fig. 9b. 

In the correction amending routine, it is determined whether or not the execution of the 
routine is first time in the step 201. If yes, the detection signals x and y obtained in the step 
20 103 are set as reference detection signals x, and y, in the step 202 and it is returned to the 20 
main routine shown in Fig. 9a. 

When it is determined in the step 201 that the amending routine is used not firstly, newest 
detection signals x and y obtained in the step 103 are set as current detection signals x n and y n 
in the step 203. Then, in the step 204, it is determined whether or not a distance l(x n — x,) 2 + " 
25 (y„— Yi) 2 } ,/2 between the coordinates corresponding to the current detection signals x„ and y n and 25 
the reference detection signals x, and y t , respectively, is equal to or larger than a first predeter- 
mined value p,. If yes, the correction values x 0 and y c are amended through the steps 205 to 
208. If no, it is returned to the main routine shown in Fig. 9a. 

Describing the amending operation in more detail, the perpendicular bisector £ with respect to 
30 the coordinates (x t ,y t ) and (x oi y n ) of the respective detection signals is obtained in the step 205. 30 

Assuming that the perpendicular bisector 9. is represented by 

y = ax + b (10 ) 

35 The constants a and b are given by the following equations 35 

a = (* n - x i )/(y n~ y i ) UOa) 

b ■ (< x l 2+ yi 2 ^{ x n 2+y n 2) ) /2(y l"yn ) V (10b) 40 



40 



Then, in the step 206, the coordinates (Xp,Vp) of the cross point of the bisector £ and a line 
extending perpendicularly from the coordinates (x 0 ,y 0 ) corresponding to the correction values Xo 
45 and y D to the bisector is obtained. 45 
The coordinates (vYp) is 9' ve n by 

X p = ( x o + a <Y 0 - b >J/( a2+1 ) dla) 
50 y p = ' ax o + b (lib) 50 

When the coordinates components yj and y„ are equal to each other, the equation of the 
55 perpendicular bisector 6 becomes . 55 

x = (x x + x n )/2 (12) 

60 Therefore, the coordinates (Xp.Vp) is given by 60 
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X p = < x i +x n )/2 (13a) 
y = y (13b) 

Then, in the step 207, the components x p and y p of the coordinates (Xp,Vp) are set as the 
correction amounts x 0 and y Q , respectively, and, after the correction signals x n and y n are set as 
the reference detection signals x, and y, in the step 208, it is returned to the main routine. 

10 Therefore, when the orientation A of the vehicle 1 is changed during the movement thereof 10 
while the above operation is performed continuously, the amending operation of the correction 
values is performed through the steps 205 to 208, so that the correction amounts x 0 and y 0 
approach the true correction amounts x^ and y v2 required to cancel out the magnetic field Hv2. 
When the field Hv2 is further changed during the repetition of the above steps, the correction 

15 values x 0 and y 0 obtained as above also approach the true correction amounts required to cancel 15 
out the changed magnetic field. Therefore, in a case where the field Hv changes time to time, 
the correction amounts x 0 and y c can be amended automatically during a normal movement of 
the vehicle 1 without necessity of turning required in the step 102 of the initial correction 
routine. As a result, the correction detection signals x h and y h obtained in the step 104 always 

20 indicate a more precise orientation of the vehicle. 20 
Fig. 10 is a flow chart showing another embodiment of the present invention, which is 
featured over the correction amending routine shown in Fig. 9b by a provision of the steps 209 
to 211. In the step 209, it is determined whether or not a distance |(x n -x n > ! ) 2 + (y n -y n -i) 2 } 1/2 
between a coordinates (x^yj corresponding to a current detection signal and a coordinates 

25 (x^^y,,-,) corresponding to a preceding detection signal is equal to or larger than a second 25 
predetermined value p 2 . If yes, the current detection signals x n and y n are set as reference 
detection signals x, and y, in the step 210. If no, it goes on through the steps 204 to 208 
identical to those in Fig. 9a, to set the current detection signals x„ and y n as the preceding 
detection signals x n _, and y n -i in the step 211 for subsequent operation. 

30 Accordingly, the embodiment in Fig. 10 provides the same effect as that obtained by the 30 
preceding embodiment and further provides an additional effect that, by judging the fact that the 
distance between the coordinates points changed during the period T to a value equal to or 
larger than the predetermined value p 2 is to indicate an occurrence of such abrupt change of 
magnetic field as shown in Fig. 5, an erroneous operation of the correction amounts x<, and y 0 

35 based on the detection signals x, and y, before the change of the magnetic field and the 35 
detection signals x n and y n after the change, i.e., the set of detection signal pairs the required 
correction amounts of which are different from each other is prevented. 

In these embodiments described hereinbefore, the correction amounts x 0 and y 0 are amended 
when the distance between the coordinates (x„y,) and (x n ,y n ) is equal to or larger than the 

40 predetermined value p, as in the step 204. The reason for this is to prevent an operation error 40 
of the perpendicular bisector from increasing substantially when the distance is too small and 
detection errors exist in the detection signals x, and y, and x n and y n . 

Therefore, if such detection error is negligible, it may be possible to operate the correction 
values x 0 and y e on the basis of the preceding and current detection signals x n _„y n _„ X and y 0 , 

45 without using the step 204. 45 
Although the present invention has been described with reference to the automobile as the 
vehicle, it may be any other vehicle such as ship and aircraft. 

As mentioned hereinbefore, according to the present invention, the correction amounts for the 
changing magnetic field intensity can be amended automatically time to time to thereby obtain 

50 the precise correction to the magnetic field. 50 

CLAIMS 

1 . A direction finder for use on a moving vehicle, comprising a terrestrial magnetism sensor 
mounted on the vehicle for detecting a pair of orthogonal components of a horizontal component 

55 of terrestrial magnetism to provide a pair of detection signals corresponding to the orthogonal 55 
components, respectively; a magnetization correction means for correcting the pair of detection 
signals with a pair of correction values necessary to cancel out the influence of a magnetic field 
produced by the vehicle and providing a pair of corrected detection signals; and a correction 
amending means for obtaining the perpendicular bisector of a line connecting two co-ordinate 

60 points corresponding to the pair of detection signals from the terrestrial magnetism sensor and 60 
the pair of corrected detection signals from the magnetization correction means on a rectangular 
co-ordinate system and to amend the correction values on the basis of the co-ordinate compo- 
nents of a crossing point of the perpendicular bisector and a line extending perpendicularly from 
the perpendicular bisector to that crossing point. 

65 2. A direction finder according to claim 1 , wherein the correction amending means amends the 65 
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correction values when the distance between co-ordinate points corresponding to a current 
detection signal pair from the terrestrial magnetism sensor and a preceding detection signal pair 
from the terrestrial magnetism sensor stored as a reference detection signal pair becomes equal 
to or larger than a first predetermined value. 
5 3. A direction finder according to claim 1 or claim 2 wherein the correction amending means 5 
utilizes a current detection signal pair from the terrestrial magnetism sensor as a reference 
detection signal pair in obtaining the perpendicular bisector when the distance between co- 
ordinate points corresponding to the current detection signal pair and a detection signal pair 
obtained by the terrestrial magnetism sensor and stored at a predetermined time before the 
10 current detection signal pair was obtained is equal to or larger than a second predetermined 10 
value. 

4. A direction finder according to any one of the preceding claims, wherein the magnetization 
correction means comprises an initial correction means responsive to an output of the sensor to 
obtain correction amounts and a correction means for correcting the pair of electric signals with 

15 the correction amounts obtained by the initial correction means and providing a pair of corrected 15 
signals. 

5. A direction finder according to any one of the preceding claims, which also includes an 
angle calculation means responsive to an output of the magnetization correction means for 
calculating an angle between a moving direction of the vehicle and a direction of the horizontal 

20 component of terrestrial magnetism; and a display means for displaying the calculated angle. 20 

6. A direction finder according to claim 5, wherein the magnetization correction means, the 
correction amending means and the angle calculation means constitute a control device and the 
control device comprises an A/D converter connected to an output of the terrestrial magnetism 
sensor, a micro-computer and a display drive connected to the display means, 

7. A direction finder substantially as described with reference to the accompanying drawings. 25 
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